function ddq=dynamic(L,m,g,torque,q,dq,b,gra_bool)
    ddq=(torque+m*g*L*cos(q)*gra_bool-b*dq)/(m*L*L);
end